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The  special  cultivation  features  of  white  asparagus  pose  new  challenges  to  the  research  and  development 
of  the  row  guidance  control.  This  paper  presents  a  row  tracking  system  of  a  two-layer  structure  for  an 
autonomous  robot  developed  to  harvest  white  asparagus.  At  the  low  level,  two  independent  speed  con¬ 
trol  loops  are  suggested  to  ensure  the  actual  revolutions  of  the  drive  motors  to  follow  their  demanded 
values.  A  cascade  control  structure,  consisting  of  an  inner  orientation  error  controller  and  an  outer  lateral 
offset  controller,  is  proposed  for  the  high  level  to  drive  the  robot  to  track  the  desired  trajectory.  The  most 
important  advantage  of  the  cascade  structure  is  that  the  inner  loop  directly  regulates  the  most  significant 
error  (the  orientation  error),  which  minimizes  the  impact  of  the  external  disturbances  upon  the  outer 
loop.  Moreover,  the  cascade  scheme  allows  the  orientation  angle  to  be  limited  within  a  given  range.  That 
ensures  a  collision-free  tracking.  The  controllers  are  designed  based  on  the  traditional  proportional-inte¬ 
gral-derivative  (PID)  algorithms.  The  control  parameters  are  selected  by  using  root  locus  analysis,  which 
guarantees  the  system  stability.  The  effectiveness  of  the  proposed  control  regime  is  evaluated  by  numer¬ 
ical  simulations  and  validated  by  experiments.  The  experimental  results  demonstrate  that  with  the  sug¬ 
gested  row  guidance  strategy  a  satisfactory  tracking  accuracy  of  ±0.5  cm  is  achieved. 

©  2011  Elsevier  B.V.  All  rights  reserved. 


1.  Introduction 

1.1.  Cultivation  and  harvest  of  white  asparagus 

White  asparagus  is  one  of  the  most  favorite  vegetables  in  Ger¬ 
many  and  well-known  as  “the  royal  vegetable”.  In  2010,  approxi¬ 
mately  92,400  tons  of  asparagus  is  harvested  on  18,800  hectares 
in  Germany  (Bonn,  2011).  The  cultivation  is  expected  to  continue 
to  expand.  White  asparagus  is  cultivated  in  parallel  trapezoidal 
mounds,  which  are  heaped  knee-highly  around  the  plants.  Each 
mound  is  covered  with  a  plastic  film  (see  Fig.  1).  To  harvest  the 
stalks  manually,  the  workers  move  firstly  the  film  aside,  cut  stalks 
off  with  a  special  knife  one  by  one,  push  the  soil  back  and  replace 
the  film  on  the  mound  at  the  end.  When  the  harvesters  cut  aspar¬ 
agus,  care  must  be  taken  not  to  damage  the  shorter  developing 
spears  under  the  ground.  The  stalks  need  to  be  cut  shortly  after 
their  spears  emerge  from  the  mound.  Otherwise  the  tips  will  turn 
into  light  purple  color,  which  decreases  the  product  quality  and  re¬ 
sults  in  significantly  lower  selling  price  (European  Commission, 
1999).  The  harvesting  time  of  white  asparagus  generally  begins 
from  early  or  mid-April  and  ends  on  June  24  every  year.  During 
these  10  weeks,  the  asparagus  is  generally  harvested  twice  a  day. 
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White  asparagus  harvesting  is  a  highly  repetitive  and  labor 
intensive  task  that  is  typically  done  manually  at  present.  With 
the  cultivation  area  expanding,  it  becomes  increasingly  difficult 
to  employ  adequate  workers  during  the  harvesting  season.  Besides, 
the  labor  cost  is  getting  increasingly  higher  (Leibniz-Institute  of 
Agricultural  Engineering,  2010).  Therefore,  it  is  essential  and  ur¬ 
gent  to  explore  an  automated  solution  for  white  asparagus  har¬ 
vesting  to  release  workers  from  the  laborious  manual  task  and  to 
lower  the  production  cost  (Geyer  et  al.,  2005).  It  is  worth  noting 
that  the  successfully  used  harvester  for  green  asparagus  harvesting 
developed  by  Arndt  et  al.  (1997)  is  not  suitable  for  the  white  aspar¬ 
agus  harvesting  due  to  the  special  cultivation  features  of  white 
asparagus.  In  recent  years,  engineers  have  been  attempting  to 
mechanize  the  harvesting  process  of  white  asparagus  and  signifi¬ 
cant  progress  has  been  achieved.  One  of  the  earliest  asparagus  har¬ 
vesting  assistant  machines  named  AspergeSpin  Al  (Wonneberge, 
2005)  was  developed  by  ENGELS  MACHINES  Innovatietechniek 
company,  Holland.  AspergeSpin  Al,  which  is  also  popularly  used 
at  present,  assists  workers  in  film  lifting,  replacing  and  also  carry¬ 
ing  the  asparagus  containers.  In  June  2008,  the  French  company 
Firma  Kirpy  presented  a  non-selective  harvesting  machine  Type 
RGA  (Uwihs,  2008)  for  white  asparagus.  Type  RGA  is  dragged  by 
a  tractor.  It  cuts  through  the  asparagus  mound  completely  and 
then  transfers  the  harvested  asparagus  spears  together  with  the 
soil  over  a  sieve  band  in  sequence.  The  asparagus  mound  is  then 
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Nomenclature 

viscous  friction  coefficient  drive  motor  (N  m  s  rad-1) 

SfO,  SrO 

initial  values  of  side  distances  S/  and  Sr,  (m),  (m) 

es 

lateral  offset  front  ultrasonic  sensor  (m) 

Sref 

desired  side  distance  (m) 

ey 

lateral  offset  mobile  robot  (m) 

T 

1  ms 

simplified  time  constant  of  Gmd  (s) 

ee 

orientation  error  mobile  robot  (rad) 

U 

motor  supply  voltage  (V) 

£y0,  €00 

initial  position  error  mobile  robot  (m),  (rad) 

Ul,Ur 

supply  voltages  for  left  and  right  drive  motors  (V),  (V) 

g 

gear  ratio  chain  gearbox  (-) 

V 

actual  forward  linear  velocity  mobile  robot  (m  s-1) 

GmPI 

transfer  function  PI  motor  speed  controller  (-) 

VdVr 

actual  linear  velocities  left  and  right  wheels  (ms-1), 

kernel 

transfer  function  closed-loop  motor  speed  controller  (-) 

(ms-1) 

GpDy 

transfer  function  PD  lateral  displacement  controller  (-) 

Vref 

desired  forward  linear  velocity  mobile  robot  (m  s-1) 

Jm 

motor  inertia  with  its  wheel  (kg  m2) 

CO 

actual  angular  speed  mobile  robot  (rad  s-1) 

I<e 

back-emf  constant  (V  s) 

OOmdiff 

differential  angular  speed  to  steer  the  vehicle  (rad  s-1) 

kpcoi  kica 

proportional  and  integral  gains  of  GmPI  (Vs  rad-1), 

rid mli  ridmr 

actual  revolutions  left  and  right  motors  (rads-1), 

(V  s  rad-1) 

(rad  s-1) 

I<m 

torque  constant  motor  (N  m  A-1) 

^ml>  ^ mr 

desired  revolutions  left  and  right  motors  (rads-1), 

kms 

simplified  gain  of  Gmd 

(rad  s-1) 

kpyjidy 

proportional  and  derivative  gains  of  GPDy 

ridmref 

desired  motor  angular  speed  (rads-1),  given  by 

kpe 

proportional  gain  orientation  controller  (s-1) 

ridmref  =  f  '  Vref 

length  and  width  mobile  robot  base  (m),  (m) 

y 

actual  lateral  displacement  (m) 

km 

inductance  drive  motor  (H) 

Vd 

desired  lateral  displacement  (m) 

Km 

motor  resistance  (Ohm) 

e 

actual  heading  direction  (rad) 

r 

radius  drive  wheel  (m) 

6d 

desired  heading  direction  of  the  robot  (rad) 

A  ref 

desired  motor  speed  (rpm),  equivalent  to  nref=  •  vref 

0ref 

reference  heading  angle  given  by  lateral  offset  controller 

SfiSr 

front  and  rear  side  distances  (m),  (m) 

(rad) 

reformed  automatically.  The  full  harvesting  machine  greatly  im¬ 
proves  the  productivity  and  relieves  the  manual  task.  However,  it 
significantly  reduces  the  output  and  quality  of  the  products  be¬ 
cause  the  shoots  that  are  developing  under  the  surface  are  also 
non-selectively  harvested  at  a  time.  In  2008,  the  German  company 
ASM  DIMANTEC  invented  a  semi-automatic  machine  named  Spar- 
gel-Panther  (Peiter,  2008).  Spargel-Panther  is  a  tractor  driven  ma¬ 
chine  designed  to  harvest  asparagus  for  three  cultivation  beds. 
With  the  help  of  a  laser  beam,  the  driver  can  locate  the  position 
of  each  asparagus  tip  by  operating  a  joystick.  The  consequent  har¬ 
vesting  procedure  is  automatically  performed  in  series,  which  con¬ 
sists  of  coordinating  the  position  of  the  harvesting  equipment, 
cutting  off  the  asparagus  under  the  ground  with  a  certain  depth, 
moving  the  shoot  out  with  a  gripper  and  transferring  it  into 
containers.  The  Dutch  company  Brabantse  Wal  presented  the  first 
prototype  of  a  full-automatic  asparagus  harvester  in  the  world  in 
2008  (Lindhout,  2008).  Although  the  above  companies  have  made 
pioneering  endeavors,  the  detailed  research  and  development 
information  is  unavailable  due  to  commercial  reasons.  In  the 


Fig.  1.  Cultivation  mounds  of  white  asparagus  and  manual  harvesting  work. 


academic  community  only  Chatzimichali  et  al.  (2009)  have  re¬ 
cently  outlined  a  conceptual  design  of  an  advanced  prototype  ro¬ 
bot  for  automatic  white  asparagus  harvesting.  In  their  work,  the 
structure  of  the  prototype  robot  consisting  of  a  caterpillar  drive 
system,  asparagus  identification  and  harvesting  system  has  been 
detailed.  The  realization  of  the  proposed  design  is  still  ongoing. 
To  the  best  of  our  knowledge,  there  is  no  other  public  research  re¬ 
port  about  full  automatic  machine  for  the  selective  harvesting  of 
white  asparagus  at  present. 

To  automate  the  harvesting  process  for  white  asparagus,  two 
primary  requirements  must  be  suited:  automated  row  guidance 
and  reaping  asparagus  automatically.  In  this  paper,  we  concentrate 
on  the  development  of  a  row  guidance  system  for  an  autonomous 
asparagus  harvesting  mobile  robot  driven  by  an  electrical  system, 
and  our  objective  is  to  develop  a  guidance  control  design  suitable 
for  the  application  in  white  asparagus  harvesting.  Our  ultimate 
goal  is  to  design  a  full  autonomous  robot  for  white  asparagus 
harvesting  (see  Fig  2). 


Fig.  2.  Mobile  robot  for  white  asparagus  harvesting  in  field. 
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1.2.  Automatic  guidance  system 

In  recent  decades,  the  development  of  technologies  such  as  ma¬ 
chine  vision  analysis,  global  positioning  systems  (GPS)  and  robotics 
allows  the  improvement  of  automatic  vehicle  guidance.  Machine 
vision  and  GPS  are  most  widely  used  for  the  row  guidance  control. 
Various  vision-based  guidance  systems  have  been  proposed  for  the 
field  machine  to  perform  weeding,  cultivating,  chemical  spraying 
and  harvesting  (Astrand  and  Baerveldt,  2002;  Benson  et  al.,  2003; 
Tillett  et  al.,  2002).  The  most  commonly  used  method  based  on  ma¬ 
chine-vision  to  identify  crop  rows  is  the  Hough  transform  (Hough, 
1962),  which  is  a  computationally  efficient  procedure  and  capable 
of  dealing  with  the  situations  where  the  crop  stand  is  incomplete 
with  gaps  in  the  crops.  In  vision  based  applications,  a  real-time 
imagery  processing  is  essential  to  separate  objects  of  interest  from 
field  images,  which  is  a  serious  challenge  for  the  processing  device 
to  execute  complex  image  processing  algorithms.  Moreover,  the 
effectiveness  of  the  vision  system  is  affected  by  lighting  conditions 
and  background  interference  (Slaughter  et  al.,  2008).  Alternatively, 
the  Real-Time  Kinematic  GPS  (RTK  GPS)  with  precision  of  a  few 
centimeters  is  commercially  available  for  some  tractors.  Stoll  and 
Kutzbach  (2000)  developed  an  automatic  steering  system  for  a 
self-propelled  forage  harvester  using  RTK  GPS  as  the  only  position¬ 
ing  sensor.  Kise  et  al.  (2002)  proposed  an  RTK  GPS  guidance  system 
for  a  field  autonomous  vehicle  traveling  along  a  curved  path  with  a 
maximal  tracking  error  of  13  cm.  To  use  the  RTK  GPS  method,  a  ref¬ 
erence  receiver  (Base)  must  be  placed  on  a  known  reference  point, 
and  a  roving  receiver  (Remote)  on  the  vehicle.  The  Base  transmits 
measurement  or  correction  information  through  a  radio  link  to 
the  Remote.  The  Base  and  Remote  must  communicate  with  each 
other  at  all  times  during  vehicle  operation  in  order  to  maintain  good 
accuracy.  This  guidance  method  suffers  from  some  limitations.  It  is 
difficult  to  guarantee  consistent  positioning  accuracy  for  varied 
field  conditions.  Another  drawback  is  the  inherent  time  delay  (Li 
et  al.,  2009).  Besides,  pre-investment  required  for  the  Base  and 
Remote  devices  is  generally  considerably  high  for  the  agricultural 
applications  (Buick,  2006). 

In  this  study,  we  introduce  firstly  the  mechanical  design  of  our 
autonomous  mobile  robot  platform  for  white  asparagus  harvesting 
(see  Fig.  2).  For  our  robot  platform,  the  objective  of  the  guidance 
control  system  is  set  so  that  the  vehicle  does  not  damage  any 
asparagus  bed  by  driving  too  close  to  it.  For  this  purpose,  a  low- 
cost  row  guidance  system  is  proposed  for  the  harvesting  applica¬ 
tion  in  the  white  asparagus  field.  The  actual  in-row  position  of 
the  vehicle  with  respect  to  the  asparagus  bed  is  derived  by  the 
front  and  rear  side  distances,  which  are  measured  by  two  ultra¬ 
sonic  sensors.  A  two-layer  architecture  for  the  guidance  control 
is  used  to  reject  the  internal  and  external  disturbances.  At  the 
low  level  two  independent  speed  controllers  are  employed  to  make 
the  drive  motors  rotate  at  the  reference  speeds  supplied  by  the  tra¬ 
jectory  controller  at  the  high  level.  A  cascade  control  system,  which 
is  composed  of  main  control  loop  of  lateral  offset  and  the  auxiliary 
loop  of  orientation  error,  is  especially  suggested  at  the  high  level  to 
reduce  the  influence  of  external  disturbances  to  the  lowest  level. 
Finally,  simulations  and  experiments  are  performed  to  evaluate 
the  tracking  performance  of  the  proposed  strategy. 

The  rest  of  this  work  is  organized  as  follows.  We  start  with  the 
mechanical  design  of  the  harvesting  robot  in  the  next  section.  Sec¬ 
tion  3.1  describes  the  vehicle  kinematics.  Section  3.2  is  devoted  to 
quantifying  the  tracking  error  using  the  front  and  rear  side  distances. 
In  Section  4.1,  we  present  a  row  tracking  system  based  on  cascade 
control  method.  The  control  system  design  is  presented  in  detail  in 
Section  4.2.  Section  5  shows  the  simulation  and  experimental  track¬ 
ing  performance  for  the  robot  with  different  initial  tracking  errors, 
and  relevant  discussions  are  drawn  subsequently.  Finally,  we  close 
with  a  brief  concluding  remarks  and  future  work  in  Section  6. 


2.  Mechanical  description  of  the  vehicle  platform 

White  asparagus  is  cultivated  in  parallel  beds  that  have  a  trap¬ 
ezoidal  cross-section  and  are  raised  up  over  the  field  surface  up  to 
50  cm  tall.  The  width  of  the  asparagus  bed  is  about  1  m  wide  at  the 
bottom,  and  the  in-row  space  is  approximately  80  cm.  We 
designed  an  autonomous  harvesting  robot  platform  for  both  effi¬ 
ciency  and  cost  effectiveness.  The  mechanical  design  is  shown  in 
Fig.  3.  The  robot  base  has  dimensions  of  3.1  x  1.8  x  1.6  m  ( l/w/h ) 
and  a  weight  without  load  up  to  450  kg,  and  its  center  of  mass  is 
located  slightly  behind  of  the  front  axis.  The  vehicle  chassis  is  com¬ 
posed  of  two  motors,  transmission  elements,  electronics,  sensors 
and  two  12  V  batteries.  The  robot  platform  is  a  differential  drive 
vehicle  and  has  two  drive  wheels  with  same  radius  of  30  cm  at 
the  front.  The  drive  wheels  are  actuated  independently  by  two 
450  W  DC  motors  supplied  with  24  V  voltage.  The  nominal  torque 
of  the  motor  is  12.6  Nm.  The  shaft  of  each  motor  is  connected  with 
its  wheel  through  a  chain  gear  box  with  a  reduction  ratio  of  16:1. 
Two  casters  with  radius  of  15  cm  are  installed  at  the  rear  to  pro¬ 
vide  balance.  Motor  speed  is  sensed  through  an  incremental  optical 
encoder.  Two  ultrasonic  sensors  are  installed  on  the  right  side  of 
the  harvester  to  measure  the  front  and  rear  side  distances  with  re¬ 
spect  to  its  tracking  row.  One  of  them  is  near  the  front  wheel  and 
the  other  near  the  rear  one.  Measurements  of  the  sensors  are  fed 
back  to  the  controllers.  The  advantage  of  ultrasonic  sensor  over  vi¬ 
sion  system  is  that  the  effectiveness  of  its  measurement  is  not  af¬ 
fected  by  lighting  conditions  and  background  interference.  It  also 
improves  computational  efficiency  and  lowers  the  cost  of  the  har¬ 
vester.  The  robot  platform  is  also  equipped  with  a  film  roller  at  the 
front,  and  through  a  sliding  channel  the  film  is  replaced  behind  the 
vehicle  automatically.  The  robot  can  be  steered  only  by  maneuver¬ 
ing  the  relative  speeds  of  the  drive  wheels. 

3.  Kinematics  and  description  of  tracking  deviation 

3.1.  Kinematics 

The  vehicle  platform  is  assumed  to  be  composed  of  rigid  bodies 
and  to  move  on  a  planar  surface.  As  the  operating  velocity  of  the 
robot  is  limited  to  5  km/h,  it  is  supposed  that  the  wheels  are 
non-deformable  and  that  there  is  no  translational  or  lateral  slip  be¬ 
tween  the  wheels  and  the  ground  surface.  The  translational  veloc¬ 
ities  of  the  left  and  right  wheels  are  obtained  by  vL  =  mm/r/g  and 
Vr  =  cjOrnr^lg,  where  comi  and  comr  are  angular  speeds  of  the  left  and 
right  drive  motors,  r  the  radius  of  the  drive  wheel  and  g  the  reduc¬ 
tion  ratio  of  the  chain  gearbox.  The  center  point  P  (see  Fig.  4)  of  the 
axle  of  the  driving  wheels  is  defined  as  the  reference  point  of  the 
mobile  robot  position.  The  forward  linear  velocity  v  and  angular 


Fig.  3.  Mechanical  design  of  the  mobile  robot  (1.  Film  roller,  2.  Sliding  channel  for 
the  film,  3.  Incremental  optical  encoder,  4.  DC  motor  5.  Front  drive  wheel,  6. 
Ultrasonic  sensor,  7.  Battery,  8.  Micro-controller,  9.  Drive  board,  10.  Caster/rear 
wheel,  and  11.  Loading  platform). 
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speed  co  at  the  point  P  can  be  described  in  the  moving  frame  as 
follows: 


v  = 


Vr  +  Vl 

2 


CO  = 


Vr  -  Vi 

Lb 


a) 

(2) 


where  Lb  is  the  distance  between  the  two  drive  wheels. 

For  the  sake  of  convenience,  the  X  axis  of  the  base  frame  is  de¬ 
fined  in  parallel  to  the  asparagus  bed  pointing  right.  In  the  base 
frame,  the  kinematic  model  of  the  differential  drive  mobile  robot 
can  be  expressed  as  (Siegwart  and  Nourbakhsh,  2004): 


y 

9 


) 


(cosO 
sinO 

0 


(3) 


where  x,  y  and  6  are  the  positions  and  orientation  of  the  robot,  x,  y 
and  6  are  their  derivatives  and  represent  the  velocities  and  angular 
speed  of  the  vehicle,  respectively. 


3.2.  Tracking  deviation  from  the  tracking  row 

In  order  to  follow  crop  rows,  it  is  necessary  to  determine  the 
vehicle  position  with  respect  to  the  target  row.  The  desired  and  ac¬ 
tual  positions  are  illustrated  in  Fig.  5  by  the  dashed  and  solid  rect¬ 
angular  frames,  respectively.  The  tracking  deviation  of  the  robot 
from  the  target  asparagus  row  can  then  be  described  using  the  lat¬ 
eral  offset  ey  and  orientation  error  e6: 


ey=yd-y,  ee  =  8d-8  (4) 

where  yd  and  9d  are  the  desired  lateral  displacement  and  heading 
angle  whose  values  are  both  zero  in  this  work,  i.e.  yd=  0,  6d  =  0. 

The  actual  orientation  and  lateral  displacement  of  the  harvest¬ 
ing  robot  are  computed  using  the  front  and  rear  side  distances 
measured  by  the  two  ultrasonic  sensors  SF  and  SR  also  shown  in 
Fig.  5.  According  to  the  geometric  relations,  the  actual  orientation 
6  can  be  calculated  using  the  side  distances  5/ and  Sr  as  follows: 

fl  =  arctan^  (5) 

where  La  is  the  length  of  the  robot  base.  The  actual  lateral  displace¬ 
ment  y  is  given  by 

y  =  es  +  sign(es )  j  (1  -  cos  8)  (6) 

es  =  Sref-Sfcos8  (7) 

where  Sref  represents  the  reference  side  distance  for  the  ultrasonic 
sensors  and  corresponds  to  the  side  distances  for  the  vehicle  by 
ey  =  0  and  e6  =  0,  es  the  actual  lateral  deviation  of  SF. 

The  actual  lateral  displacement  y  and  the  heading  angle  9  are 
fed  back  to  the  trajectory  controller  at  the  high  level  to  generate 
the  desired  speeds  for  the  drive  motors.  Considering  that  the  aspar¬ 
agus  beds  are  composed  generally  of  linear  segments  and  extre¬ 
mely  soft  arcs,  the  direction  deviation  of  the  tracking  row  is 
within  3°.  Therefore,  it  is  reasonable  to  make  an  approximation 
of  sin 9  «  9.  The  tracking  deviation  of  the  mobile  robot  from  the 
aimed  trajectory  can  be  rewritten  as: 

y=v9  (8) 

9  =(j)  (9) 


4.  Row  guidance  control  design 

Differential  drive  robots  have  restricted  motion  due  to  their  non- 
holonomic  constraints.  To  ensure  the  global  stability  for  any  arbi¬ 
trary  trajectory,  considerable  nonlinear  control  techniques  have 
been  suggested.  The  more  often  employed  strategies  are  based  on 
the  nonlinear  state  feedback  (Aguilar  et  al.,  1998;  Chwa,  2010; 
d’Andrea-Novel  et  al.,  1995;  Zhang  et  al.,  1997),  adaptive  control 
(Colbaugh  et  al.,  1998;  Mazur,  1997),  model-based  predictive  con¬ 
trol  (Klancar  and  Skrjanc,  2007)  and  intelligent  control  method  like 
fuzzy  logic  (Espinosa  et  al.,  2001;  Tso  et  al.,  1996).  However,  the 
nonlinear  control  methods  are  usually  quite  complicated  in  appli¬ 
cations  and  the  computation  effort  is  too  large  to  be  implemented 
on  an  economic  micro-controller  in  real-time  (Chwa,  2010), 
although  rigorous  analysis  has  been  performed  for  the  controller 
development  to  guarantee  the  system  stability.  Therefore,  from 
the  viewpoint  of  a  practical  application,  it  is  desirable  to  adopt 
the  PID  controllers  (Chwa,  2010).  Borges  et  al.  (2000)  proposed  a 
P  controller  based  on  feedback  trajectory  control  design  for  an  auto¬ 
mated  mobile  robot  in  laboratory.  Marchant  et  al.  (1997)  suggested 
a  simple  PD  controller  for  the  row  following  system  of  an  autono¬ 
mous  vision-guided  agricultural  vehicle.  With  the  PD  controller, 
the  agricultural  vehicle  tracked  the  target  trajectory  with  satisfying 
performance.  The  row  guidance  control  for  our  harvesting  robot  is 
designed  based  upon  the  conventional  PID  algorithms. 

4A.  Control  architecture 

The  two-layer  control  structure  shown  in  Fig.  6  is  composed  of  a 
trajectory  control  system  at  the  high  level  and  a  wheel  speed  con¬ 
trol  system  at  the  low  level.  In  this  figure,  the  thin  black  arrows 
represent  the  electrical  signal  routes  and  the  thick  left  and  right 
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Fig.  6.  Block  diagram  of  the  row  guidance  control  structure. 


arrows  in  gray  represent  the  mechanical  connections.  The  trajec¬ 
tory  controller  at  the  high  level  with  a  cascade  structure  supervises 
the  tracking  error,  which  is  calculated  using  the  front  and  rear  side 
distances  5/  and  Sr.  According  to  the  actual  tracking  error,  the  lat¬ 
eral  offset  controller  in  the  outer  loop  adjusts  the  set-point  6ref  of 
the  inner  loop  in  real-time.  The  orientation  controller  then  gener¬ 
ates  the  differential  term  for  the  motor  speeds  to  adjust  the  orien¬ 
tation  angle  9.  The  speed  control  system  at  the  low  level  is 
composed  of  two  individual  speed  control  loops  for  the  drive  mo¬ 
tors,  illustrated  by  Motor  L  and  Motor  R  in  Fig.  6.  The  speed  loops 
are  employed  to  ensure  that  the  actual  motor  speed  com  always  fol¬ 
lows  the  desired  speed  co*m.  The  reference  angular  speeds  of  the 
motors  are  formulated  as  follows: 

(Dmi  =  ^ ref  ~  (D mdiff  (10) 

09  mr  —  (Dref  +  (Dmdiff  (1 1 ) 

where  co*ml  and  co*mr  are  the  desired  angular  speeds  for  the  left  and 
right  motors,  respectively.  Each  desired  speed  consists  of  two  com¬ 
ponents:  a  primary  angular  speed  comref  and  a  differential  term 
comdiff ■  cDmref  is  equivalent  to  the  desired  forward  linear  velocity  vref 
given  by  comref=  vrejglr.  comdiff  is  determined  by  the  orientation  con¬ 
troller  at  the  high  level  and  used  to  compensate  the  tracking  error.  If 
the  tracking  error  is  zero,  i.e.  ey  =  0  and  ee  =  0,  then  comdiff  =  0.  The 
vehicle  drives  straightly  forward  with  the  motors  operating  at  the 
same  speed.  Otherwise,  by  coref  #  0  the  trajectory  controller  is  acti¬ 
vated.  The  machine  then  orients  itself  through  the  adjustment  of 
the  motor  speeds  simultaneously  to  eliminate  the  tracking  error. 

As  for  the  tracking  control  of  the  differential  drive  mobile  ro¬ 
bots,  the  orientation  error  e6  is  more  sensitive  and  has  the  signifi¬ 
cant  impact  on  the  tracking  error,  because  the  lateral  error  ey 
depends  on  ee  and  its  time  increment.  Moreover,  ee  is  a  direct  result 
of  the  external  disturbances.  Therefore,  the  cascade  system  sug¬ 
gested  for  the  trajectory  system  is  advantageous  in  that  it  sup¬ 
presses  the  effect  of  the  external  disturbances  on  the  primary 
process  variable  ey.  As  compared  with  the  guidance  control  design 
with  a  single  controller  (Borges  et  al.,  2000;  Marchant  et  al.,  1997), 
the  cascade  structure  enables  the  heading  angle  9  to  be  restricted 
through  limiting  the  output  of  the  lateral  offset  controller.  Accord¬ 
ingly,  the  violent  sway  of  the  rear  part  of  the  robot  is  avoided  dur¬ 
ing  the  adjustment  of  the  tracking  controller.  This  makes  the 
movement  of  the  robot  more  stable,  which  is  at  the  expense  of 
the  convergence  time  of  the  tracking  error. 

4.2.  Controller  design 

The  speed  controller  is  of  proportional-integral  type  and  repre¬ 
sented  as 


where  kpco  and  kico  are  the  proportional  and  integral  gains,  respec¬ 
tively.  The  open  loop  transfer  function  of  the  motor  from  the  rota¬ 
tional  speed  com  to  the  input  voltage  u  is 


(Dm  _  Ke 

id  JmLms 2  +  ( LmBm  -j-JmRm)s  +  BmRm  +  KeKm 


(13) 


where  Lm  is  the  motor  inductance,  Rm  the  motor  resistance,  Bm  the 
viscous  friction  coefficient  and  Jm  the  equivalent  motor  inertia  to¬ 
gether  with  its  drive  wheel.  I<e  and  I<m  are  the  motor  voltage  con¬ 
stant  and  torque  constant,  respectively. 

The  resulting  closed-loop  transfer  function  of  the  speed  loop  is 
given  by: 

q  _  Ke(kpojS  T~  kioj) 

mcl  Jm^mS3  +  (LmBm  +JmRm)s2  +  ( kpcoKe  +  BmRm  +  KeKm)s  +  ki0)Ke 

(14) 


To  simplify  the  controller  design  at  the  high  level,  the  three-order 
model  in  Eq.  (14)  is  replaced  with  an  approximate  first-order  sys¬ 
tem  with  time-delay  given  in  Eq.  (15). 


(Dm  _  kms 

04  -  Tmss  +  1 


(15) 


where  kms  is  the  equivalent  loop  gain,  and  Tms  the  equivalent  delay 
time.  Note  that  this  approximation  is  made  only  to  design  the  con¬ 
trollers  at  the  high  level,  and  in  the  simulation  studies  the  original 
motor  speed  system  is  still  adopted. 

As  the  time  constant  of  the  dynamics  is  considerably  smaller 
than  that  of  the  row  tracking  system,  the  transient  response  of 
the  motor  speed  was  neglected  in  the  trajectory  controller  design, 
and  the  expression  com  =  co*m  holds.  The  forward  linear  velocity  v  is 
considered  as  constant  and  equals  to  vref  according  to  the  steering 
strategy  given  by  Eqs.  (10)  and  (11).  The  tracking  deviation  can  be 
expressed  as  follows: 


y=v9 


(CDmr 


( Dmr ) 


(16) 

(17) 


It  is  seen  from  Eqs.  (16)  and  (17)  that  the  heading  angle  9  can  be 
regulated  only  by  the  differential  speed  of  the  right  and  left  motors 
and  that  the  lateral  displacement  y  can  be  adjusted  only  by  the 
heading  angle  9. 

The  open-loop  transfer  function  of  the  orientation  system  con¬ 
tributes  the  integral  role.  With  a  proportional  controller,  the  objec¬ 
tive  of  a  zero  steady-state  error  can  be  achieved  for  the  orientation 
angle  control.  With  the  proportional  gain  kpG  the  closed-loop  trans¬ 
fer  function  of  the  orientation  control  system  is  derived  as: 


G 


mPI 


0  _  kpokmsf 

(^)  9ref  LbTmsgs2  +  Lbgs  +  kp0kmsr 


(18) 
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Fig.  7.  Block  diagram  of  the  cascade  tracking  control  system. 


Table  1 

Simulation  and  experimental  parameters. 


Parameter 

Value 

Wheel  radius  r  (m) 

0.3 

Gear  ratio  g  (-) 

16:1 

Vehicle  width  Lh  (m) 

2.1 

Supply  voltage  u  (V) 

24 

Motor  inertia  Jm  (kg  m2) 

0.0738 

Motor  inductance  Lm  (H) 

1  x  10-4 

Viscous  friction  coefficient  Bm  (N  m  s  rad-1) 

4.3  x  10-3 

Back-emf  constant  Ke  (V  s  rad-1) 

0.45 

Torque  constant  Km  (N  m  A-1) 

0.45 

Simplified  gain  motor  closed-loop  speed  controller  kms  (-) 

1 

Simplified  time  constant  motor  closed-loop 

0.137 

speed  controller  Tms  (s) 

Proportional  gain  orientation  controller  kpe  (s-1) 

204 

Proportional  gain  lateral  controller  kky  (rad  m-1) 

10 

Integral  gain  lateral  controller  kdy  (rad  m-1) 

3 

The  lateral  offset  controller  is  of  a  proportional-derivative  type  and 
represented  as: 

GpDy  -  kpy  +  kdys  (19) 

where  kpy  and  kdy  are  the  proportional  and  derivative  gains.  The 
resulting  transfer  function  of  the  closed-loop  system  is 

y_  = _ kpekmsrv(kdys  +  kpy) _ 

yd  LbTmsgs3  +  Lbgs2  +  kp0kmsr(  1  +  kdy  v)s  +  kpykpBkmSrv 

The  block  diagram  of  the  simulation  system  is  illustrated  in  Fig.  7. 
Parameters  of  the  controllers  were  selected  for  the  response  of 
the  system  dynamics  with  neither  overshoot  nor  steady  state  error 
based  upon  the  root  locus  analysis.  The  parameters  of  the  robot  are 
collected  in  Table  1,  where  the  parameters  of  the  drive  motor  were 
determined  experimentally. 

5.  Results  and  discussion 

5.1.  Simulation  studies 

Numerical  simulations  were  carried  out  to  evaluate  the  tracking 
performance  of  the  proposed  control  design.  An  accurate  simula¬ 
tion  model  capable  of  capturing  kinematics  of  the  mobile  robot 
base  is  established  in  MATLAB/Simulink.  Considering  the  limita¬ 
tions  of  the  working  space  and  the  nonholonomic  constraints  of 
the  movement  of  the  differential  drive  mobile  robot,  a  few  con¬ 
straints  were  imposed  on  the  guidance  system.  The  initial  position 
of  the  robot  is  limited  by  the  constraint  given  in  Eq.  (21).  This  is 
achieved  by  adjusting  the  posture  of  the  robot  before  its  startup. 

M  <  5  cm,  |e„o|  <  2°  (21) 

A  more  stringent  constraint  given  in  Eq.  (22)  was  imposed  on  the 
orientation  angle  to  avoid  any  possible  collision  between  the  vehi¬ 
cle  and  asparagus  rows,  which  is  realized  through  limiting  the  out¬ 
put  of  the  lateral  offset  controller. 

\ee\  ^  1.53°,  i.e.  |S/-Sr|  ^  8  cm  (22) 

It  is  worth  noting  that  in  the  applications  of  the  field  robots,  any  sud¬ 
den  change  in  the  wheel  speed  can  cause  uncontrollable  movement 


of  the  vehicle  due  to  the  inertial  force  and  skidding.  Therefore,  the 
differential  term  comdiff  is  limited  to  0.523  rad/s  to  avoid  the  slippage 
of  the  wheels.  Note  that  the  actual  position  (y,  6)  of  the  robot  were 
established  by  using  pseudo-measurements  of  the  ultrasonic  sen¬ 
sors  according  to  Eqs.  (5)  and  (6)  in  the  simulation  studies. 

A  number  of  simulation  studies  were  repeatedly  conducted  to 
evaluate  the  tracking  performance  of  the  proposed  row  guidance 
controller.  Two  group  simulation  studies  of  different  desired  veloc¬ 
ities  vref  with  four  representative  initial  errors  were  demonstrated. 
In  the  two  groups,  z;re/was  specified  as  0.12  m/s  ( nref=  60  rpm)  and 
0.16  m/s  (nre/=8 0  rpm),  respectively.  In  the  first  group  the  robot 
started  up  with  two  different  initial  trajectory  errors  of 
(eyo,e0O)  =  (5.O4cm,  -1.33°)  and  (eyO,e0O)  =  (-3  cm,  -0.57°).  A 
lateral  deviation  of  1  cm  from  the  target  row  was  introduced  at 
40s  to  examine  the  performance  of  the  guidance  controller  in  terms 
of  the  external  disturbance.  The  tracking  performance  is  shown  in 
Fig.  8.  In  the  second  group,  the  robot  started  up  from  two  different 
initial  positions  of  (eyO,e0O)  =  (5.04  cm,  -1.33°)  and  (eyo,e0O)  = 
(-4  cm,  -2.05°).  The  tracking  profiles  are  illustrated  in  Fig.  9.  For 
each  case,  the  vehicle  is  required  to  converge  to  the  desired  trajec¬ 
tory  of  (eyO,e0o)  =  (0  cm,  0°),  i.e.  (5/d,5rd)  =  (30  cm,  30  cm). 

From  the  simulation  results  illustrated  in  Figs.  8  and  9,  some 
conclusions  are  drawn  as  follows: 

The  regulation  process  of  the  initial  tracking  error  is  divided 
into  three  stages.  In  the  first  stage,  the  orientation  error  ee  is  ad¬ 
justed  to  its  boundary  in  that  the  inner  loop  of  the  cascade  system 
plays  the  primary  role.  It  is  seen  that  the  motors  drive  with  differ¬ 
ent  speeds  in  this  stage.  The  relative  position  of  the  robot  with 
respective  to  its  target  trajectory  is  demonstrated  by  the  side  dis¬ 
tances  Sf  and  Sr.  In  the  second  stage,  the  inner  loop  is  saturated 
and  e6  is  kept  at  its  upper  or  lower  limit  and  the  motors  operate 
at  the  same  speed.  The  outer  loop  plays  the  leading  role,  and  the 
lateral  error  suffers  a  rapid  decrease  to  zero.  Lastly,  the  orientation 
controller  comes  off  saturation.  ee  converges  to  zero  through  the 
adjustment  of  the  motor  speeds.  Thereafter,  the  robot  drives  in 
parallel  to  the  target  trajectory. 

In  Fig.  8,  while  a  step  signal  of  1  cm  is  introduced  to  Sf  as  a  dis¬ 
turbance  at  40s,  ey  increases  from  zero  to  1  cm  simultaneously.  The 
trajectory  controller  is  then  activated.  By  adjusting  the  motor 
speeds,  Sr  increases  drastically  from  its  reference  value  to  orient 
the  robot.  e6  begins  to  reduce  after  ey  decreases  to  zero.  Under 
the  control  effect  of  the  guidance  system,  the  injected  disturbance 
is  eliminated  very  quickly. 

By  comparison  of  simulation  results  in  Fig.  8(a)  with  those  in 
Fig.  9(a),  where  the  tracking  performances  for  the  vehicle  with 
the  same  initial  position  are  shown,  it  is  observed  that  the  higher 
forward  velocity  of  0.16  m/s  (in  Fig.  9(a))  than  that  of  0.12  m/s 
(in  Fig.  8(a))  accelerates  the  converging  process  of  ey  by  7s.  The 
converging  time  of  the  tracking  error  is  reduced  from  19s  to  12s. 

It  is  concluded  that  in  all  simulation  cases  the  proposed  control¬ 
ler  successfully  drives  the  robot  to  the  desired  trajectory,  and  an 
accurate  row  tracking  is  accomplished. 

5.2.  Experimental  results 

The  described  control  structure  has  been  implemented  on  the 
experiment  platform  in  laboratory  as  is  illustrated  in  Fig.  10.  The 
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Fig.  8.  Simulation  results  of  the  tracking  performance  for  nre/=  60  rpm.  (a)  ( ey0,ego )  =  (5.04  cm,  -1.33°),  (b)  (eyo,eeo)  =  (-3  cm,  0.57°). 
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Fig.  9.  Simulation  results  of  the  tracking  performance  for  nrej=  80  rpm.  (a)  ( eyo,eeo )  =  (5.04  cm,  -1.33°),  (b)  (eyo,e0O)  =  (-4  cm,  -2.1°). 


guidance  control  algorithms  is  programmed  using  LabView  devel¬ 
opment  environment  and  downloaded  on  a  FPGA  chip  integrated 
in  the  NI  PXI7851R  module.  The  program  is  executed  with  a  fre¬ 


quency  of  500  Hz.  The  control  signal  provided  by  the  PXI7851R 
module  is  connected  with  a  Sabertooth  motor  driver  to  regulate 
the  motor  speeds.  The  actual  motor  revolution  is  sensed  using  a 
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Fig.  10.  Schematic  illustration  of  the  real-time  experimental  setup. 
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Fig.  11.  Experimental  results  of  the  tracking  performance  for  nre/= 

Model  120E  incremental  optical  encoder,  which  has  a  resolution  of 
128  pulses  per  revolution.  The  side  distances  with  respect  to  the 
target  row  is  measured  by  two  Parallax  PING)))  ultrasonic  sensors 
which  have  an  angular  aperture  of  43°.  The  time  duration  of  the 
echo  signal  sensed  by  the  ultrasonic  sensor  is  used  to  calculate 
the  actual  distance.  To  improve  the  accuracy  of  the  measured  mo¬ 
tor  speeds  and  distances,  the  measuring  system  is  performed  with 
an  execution  time  of  20  ps.  The  sensed  and  resulting  data  are  saved 
and  visualized  on  a  computer.  To  allow  for  a  fair  comparison  be¬ 
tween  the  simulation  and  the  experimental  results,  the  same  initial 
tracking  errors  for  the  mobile  robot  used  in  the  simulation  studies 
were  also  applied  to  carry  out  the  experiments.  Note  that  each 
experiment  was  repeated  more  than  three  times.  And  each  time 
we  got  the  similar  tracking  performance.  The  only  minor  difference 
is  the  response  of  the  Sr  at  the  startup  instant  due  to  the  uncontrol¬ 
lable  movement  of  the  casters.  One  set  of  the  experimental  results 
are  shown  in  Figs.  11  and  12. 

It  is  illustrated  that  the  experimental  results  agree  rather  well 
with  the  simulation  ones.  These  experimental  results  demonstrate 
that  with  the  proposed  guidance  control  method  based  on  cascade 
control,  a  satisfactory  tracking  performance  with  an  accuracy  of 
±0.5  cm  is  achieved. 
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rpm.  (a)  (eyO,e0O)  =  (5.04  cm,  -1.33°),  (b)  ( eyO,e0O )  =  (-3  cm,  0.57°). 

Differently  from  the  simulation  results,  the  motor  speeds  be¬ 
have  measuring  noise  and  oscillation  in  the  experimental  results. 
This  can  be  mainly  accounted  for  the  imperfect  mechanical  mon¬ 
tage,  friction  of  the  chain  gearbox  and  the  limited  resolution  of 
the  encoder.  It  is  also  observed  that  the  rear  side  distance  vibrates 
near  the  desired  value  with  a  maximal  value  of  ±5  cm  after  Sf  ap¬ 
proaches  its  desired  value  Sref.  The  vibration  of  Sr  is  especially  evi¬ 
dent  in  Fig.  11(a)  due  to  the  relative  obvious  lateral  offset.  The 
more  evident  vibration  of  Sr  than  that  of  S/can  be  mainly  explained 
by  the  large  ratio  of  the  rotate  radius  of  the  rear  sensor  to  that  of 
the  front  sensor  by  3.4:1.  Another  cause  of  the  vibration  is  the 
uncontrollable  swing  movement  of  the  rear  casters.  The  fluctuation 
of  Sr  at  the  beginning  (see  Figs.  11(a)  and  12(a))  is  due  to  the 
unmanageable  initial  motions  of  the  casters. 

Note  that  the  orientation  angle  is  stringently  constrained  by  the 
lateral  offset  controller.  The  larger  the  operational  region  of  the  ori¬ 
entation  angle  is,  the  quicker  the  tracking  error  converges,  but  the 
more  violently  the  rear  part  of  the  vehicle  fluctuates,  which  en¬ 
ables  the  robot  to  run  the  risk  in  colliding  with  the  target  row  or 
its  neighbors.  A  compromise  must  be  made  between  quickness 
and  stability  of  the  controlled  system.  The  cascade  control 
structure  was  proposed  especially  for  the  application  of  the  white 
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Fig.  12.  Experimental  results  of  the  tracking  performance  for  nre/=  80  rpm.  (a)  (ey0,ee0)  =  (5.04  cm,  -1.33°),  (b)  ( eyO,e0O )  =  (-4  cm,  -2.1°). 


asparagus  mobile  robot  to  stabilize  the  robot  pose  during  the 
adjustment  of  the  tracking  error,  but  the  reported  approach  is 
not  limited  to  the  row  guidance  system  in  this  work.  And  it  has  a 
wide  applicable  capability  and  can  be  applied  to  the  differential- 
drive  mobile  robots  whose  heading  directions  are  constrained 
due  to  their  special  working  situations.  The  advantage  of  the  sec¬ 
ondary  loop  of  the  cascade  control  system  is  evident.  It  limits  the 
orientation  deviation  with  respect  to  the  target  trajectory  and  sta¬ 
bilizes  the  robot  pose.  This  regulation  regime  is  optimal  for  the 
application  objective  considering  that  the  working  condition  of 
our  white  asparagus  harvester  with  differential  drive  system.  It 
has  been  verified  by  simulations  and  experiments  that  the  fierce 
movement  of  the  rear  side  distance  is  avoided,  and  collision-free 
row  tracking  is  thus  accomplished. 

6.  Conclusions  and  future  work 

In  this  paper,  we  have  discussed  a  novel  control  strategy  for  the 
row  guidance  system  for  a  differential  drive  field  mobile  robot  that 
is  developed  to  harvest  white  asparagus.  The  guidance  system  fea¬ 
tures  a  two-layer  structure  and  provides  the  ability  to  reject  the 
internal  and  external  disturbances.  Two  independent  speed  loops 
at  the  low  level  have  been  designed  to  achieve  stable  motor  speeds. 
A  cascade  control  system  has  been  suggested  at  the  high  level, 
which  is  composed  of  a  primary  lateral  offset  loop  and  a  secondary 
orientation  error  loop.  The  cascade  design  allows  constraints  on 
the  orientation  angle  to  be  imposed  conveniently  through  limiting 
the  output  of  the  lateral  offset  controller.  The  effectiveness  of  the 
proposed  control  regime  has  been  evaluated  numerically  and 
experimentally.  The  results  show  that  it  is  effective  in  eliminating 
the  initial  error  and  tracking  deviation.  The  most  important  advan¬ 
tage  of  the  inner  orientation  control  loop  is  that  it  controls  directly 
the  most  significant  error,  which  minimizes  the  influence  of  the 
external  disturbances  to  the  lateral  offset.  Therefore,  the  controlled 
system  exhibits  short  settling  time  as  well  as  excellent  disturbance 


rejection  capability.  Additionally,  the  constraint  posed  upon  the 
orientation  angle  has  restricted  the  variation  range  of  the  rear  side 
distance,  which  prevents  effectively  the  robot  from  colliding  with 
the  asparagus  bed.  As  a  result,  a  satisfactory  tracking  performance 
has  been  achieved  with  high  accuracy  of  ±0.5  cm. 

In  future  works,  the  research  will  be  deserved  to  improve  the 
row  guidance  system  by  considering  the  dynamics  of  the  robot 
and  test  the  row  guidance  system  of  the  harvesting  robot  in  the 
asparagus  field.  Another  significant  task  is  to  develop  the  auto¬ 
matic  asparagus  harvesting  equipment,  to  fulfill  the  function  of 
asparagus  spear  identification,  location,  cutting,  holding,  arrange¬ 
ment  and  so  on. 
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